Maze Solving Robot Algorithm